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Abstract 

Many  approaches  to  force  control  have  sissumed  the  ability  to  command  torques  accu¬ 
rately.  Concurrently,  much  research  has  been  devoted  to  developing  accurate  torque 
actuation  schemes.  Often,  torque  sensors  have  been  utilized  to  close  a  feedback  loop 
aroimd  output  torque.  In  this  paper,  the  torque  control  of  a  brushless  motor  is  in¬ 
vestigated  through:  the  design,  construction,  and  utilization  of  a  joint  torque  sensor 
for  feedback  control;  and  the  development  and  implementation  of  techniques  for  phase 
current  based  feedforeward  torque  control.  It  is  concluded  that  simply  closing  a  torcpie 
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Chapter  1 
Introduction 

1.1  Background 

A  significant  portion  of  the  research  conducted  at  MIT's  Artificial  Intelligence  Lab  is 
devoted  to  robotics.  In  our  group,  headed  by  Dr.  Ken  Salisbury,  research  is  being 
conducted  on  the  design  and  control  of  robotic  arms  and  manipulators.  One  aspect 
of  the  work  centers  around  the  Salisbury  Hand,  including  the  development  of  control 
strategies,  grasp  planning  techniques,  and  sensor  development  and  implementation. 
More  recently,  the  scope  of  research  has  expanded  to  include  development  of  a  low 
friction  cable  driven  manipulator. 

When  my  research  began,  my  job  was  to  investigate  permanent  magnet  l)rushless 
DC  motor  technology.  The  lab's  interest  was  fourfold:  First,  permanent  magnet  brush¬ 
less  DC  motor  and  controller  technology  was  improving  rapidly.  Second,  it  appeared 
that  permanent  magnet  brushless  DC  motors,  hereafter  referred  to  as  brushless  motors, 
would  find  broad  application  in  the  robotic  field  as  performance  specifications  improved 
and  unit  prices  dropped.  Third,  brushless  motors  represented  a  logical  evolution  of  the 
technology  used  in  the  conventional  DC  brush  motors  on  the  Salisbury  Hand.  Finally, 
the  use  of  brushless  motors  promised  to  eliminate  the  large  brush  friction  characteristic 
of  conventional  motors  ami  to  improve  torque  and  response  ciuiracteristics.  Given  rhe 
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lab’s  interest,  the  goal  of  my  thesis  research  became  to  select  a  brushless  motor  and 
controller  fon.the  lab,  study  and  develop  techniques  for  brushless  motor  torque  control, 
and  evaluate  the  usefulness  of  brushless  motors  in  force  control  applications. 

I  felt  that  the  best  approach  to  accomplishing  all  or  part  of  this  goal  would  be 
to  take  a  systems  approach.  By  this,  I  mean  that  it  is  important  to  look  at  all  parts 
of  a  torque  control  system  and  make  improvements  in  those  areas  which  will  most 
effectively  increase  the  accuracy  of  the  system  as  a  w'hole.  I  felt  that  it  was  important 
not  to  optimize  one  piece  of  the  system  without  first  (leteniiining  where  improvements 
could  be  made  and  whether  any  parts  of  the  system  were  redundant.  For  example,  I 
sought  to  answer  the  question,  are  mechanical  torque  sensors  necessary  for  accurate 
torque  control? 

During  my  research,  e,xperi mental  work  was  carried  out  using  a  brushless  motor 
and  torcpie  controller  purchased  from  Moog  Inc.  The  Moog  equipment  was  chosen  for 
several  reasctns  after  surveying  the  brushless  motors  and  controllers  available  commer¬ 
cially:  1 )  the  motor / controller  exhibited  good  performance  characteristics  in  the  range 
we  were  interested  in,  2)  the  controller  was  designed  for  sinusoidal  commutation.  3) 
the  controller  allowed  us  to  get  hooks  into  areas  that  we  were  interested  in,  and  4)  the 
Moog  documentation  appeared  to  be  clear  and  complete.  In  my  research,  first  a  me¬ 
chanically  compliant  torque  sensor  was  developed  to  allow  torque  feedback  and  closed 
loop  torque  control.  The  torque  >ensor  was  designed  to  be  compatible  with  the  new 
cable  driven  uiampuiator  design  being  devehtped  bv  the  lab.  In  the  second,  the  tortiue 
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characteristics  of  the  luctor  we  e  hivestigatcu.  Then,  two  nietbocia  were  deveioped  to 
accurately  control  motor  output  torque.  Iii  the  fir.st  method,  fcedforv/ard  open  loop 
compensation  techniques,  utilizing  closed  loop  phase  current  control,  were  implemented 
to  minimize  torque  ripple. 

The  next  section  outlines  the  major  research  that  has  been  done  in  force  control. 
Chapter  2  presents  a  brief  description  of  brushless  motors,  their  performance  charac¬ 
teristics,  and  control.  In  addition,  a  description  is  given  of  the  Moog  brushless  motor 
and  controller  used  in  this  research.  Chapter  3  discusses  the  need  for  accTi.rate  torque 
control,  citing  releveiit  research.  The  development  of  torque  sensors  to  improve  tortfue 
control  characteristics  is  then  presented.  In  Chapter  4,  various  sources  of  brushless 
motor  torque  ripple  are  described  and  methods  are  given  for  minimizing  torque  ripple 
based  on  current  waveform  modification  and  feedforward  compensation.  In  the  final 
chapter,  results  of  the  two  torque  control  techniques  are  compared  and  critiqued. 

1.2  Research  in  Force  Control 

Research  in  force  control  has  been  aimed  at  developing  accurate  methods  to  control 
the  interartiou  forces  between  a  robotic  manipulator  and  its- environment.  Many  re¬ 
searchers  have  cited  the  need  to  control  contact  forces  while  executing  certain  tasks. 
Ideally,  one  desires  a  practically  limitless  bandwidth  mechanism  that  can  apply  com¬ 
manded  forces  and  control  interaction  forces  resulting  from  contact  with  an  uncertain 
environment.  Thi.s  usually  implies  that  one  can  command  maiuptiiaror  position  alcnig 
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soHiC  axes  of  :notiou  in  addition  to  interaction  force  along  orthogonal  axes. 

In  order  to  put  force  control  research  into  perspective,  it  is  necessary  to  review 
the  work  that  has  been  done.  Whitney  (1985)  provided  a  good  overview  of  force 
control  strategies.  Maples  (1986)  followed  with  a  framework  to  categorize  force  control 
iujpleiueutations.  In  view  of  these  I  will  present  an  overview  of  the  basic  approaches  to 
force  control  and  then  give  a  more  or  less  chronological  listing  of  force  control  research 
in  order  to  better  convey  the  current  state  of  force  control  research  and  where  it  is 
headed. 

Manipulator  force  control  techniques  can  be  either  passive,  active  or  both.  Pas¬ 
sively  compliant  manipulators  can  be  designed  to  exhibit  compliance  in  certain  direc¬ 
tions  in  order  to  control  contact  forces.  Drake’s  (1978)  Remote  Centered  Compliance, 
developed  at  Draper  Labs,  is  perhaps  the  best  known  passively  compliant  force  con¬ 
trol  implementation.  Active  force  control  invoh'es  controlling  forces  through  actuator 
commands.  In  open  loop  or  implicit  force  control,  there  is  no  force  feedback.  Contact 
forces  are  controlled  by  commanding  joint  torques  or  ad  justing  servo  gains  to  acheive  a 
desired  manipulator  stiffness.  Force  control  implementations  on  the  Direct  Drive  Arm 
(An  1986')-are  a  good  example.  There  are  four  other  types  of  active  force  control  wliirh 
involve  some  type  of  feedback. 

The  first  type,  referred  to  as  damping  (Whitney  1977),  accomodation,  or  admit¬ 
tance  control,  transforms  sensed  forces  into  joint  velocity  commands  through  applica¬ 
tion  of  a  so-called  inverse  damping  matrix.  Damping  control  can  be  acheived.  without 
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invoking  an  inverse  damping  matrix,  by  adjusting  the  velocity  feedback  gains  at  the 
joints  (Abramowitz  1984).  It  is  arguable  that  this  feJls  into  the  category  of  passive 
force  control.  Stiffness  control  (Salisbury  1980),  the  second  type  of  active  feedback 
force  control  techniques,  specifies  a  linear  relationship  between  position  error  and  com¬ 
manded  force.  Sensed  forces  are  transformed  into  commanded  positions.  The  third 
type,  impedance  control  (Hogan  1985),  utilizes  damping  and  stiffness  matrices  to  con¬ 
trol  the  relationship  between  the  deviation  from  the  comxnanded  virtu^ll  manipulator 
position  and  the  forces  exerted  by  the  manipulator  on  the  environment.  Stiffness  con¬ 
trol  could  be  considered  a  subset  of  impedance  control.  Finally,  hybrid  force/posiiion 
control  (Raibert  and  Craig),  involves  using  two  complementary  control  systems.  Po¬ 
sition  and  force  control  loops  operate  simultaneously  to  control  interactions  with  the 
environment. 

In  order  to  better  understand  these  techniques,  it  is  necessary  to  look  at  the  details 
of  their  implementation.  It  is  also  useful  to  put  them  in  better  context  with  other  work 
in  force  control.  Inoue  (1974)  demostrated  that  precise  assembly  could  be  achieved 
with  a  robot  employing  feedback  from  a  force  sensing  wrist.  The  first  attempt  at 
hybrid  active  force  control  involved  a  Cartesian  based  force  control  scheme.  The  goal 
of  this  hybrid  technique  was  to  simultaneously  satisfy  orthogonal  position  and  force 
trajectory  constraints  in  Cartesian  space.  Paul  and  Shimano  (1976)  implemented  a 
Cartesian  based  force  specification  in  manipulator  joint  space.  In  their  work,  joints 
most  nearly  aligned  with  compliant  specifications  in  Cartesian  space  were  controlled 
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to  provide  force,  while  the  reinaiuing  joints  were  position  controlled.  Motor  currents 
were  measured  to  infer  joint  torque.  Shiiuano  and  Roth  (1976)  presented  a  paper 
on  force  sensing.  Their  work  included  a  technique  for  the  automatic  calibration  of  a 
wrist  force  sensor.  Wliitney  proposed  the  “generalized  damper”  force  control  scheme  in 
( 1977)  in  which  force  sensor  feedback  was  transformed  to  joint  velocity  commands  with 
an  inverse  damping  matrix.  Whitney  proposed  that  a  stable  inverse  damping  matrix 
could  be  formulated  with  knowledge  of  the  combined  stiffness  of  the  environment  and 
force  sensor.  Whitney’s  implementation  used  a  wrist  mounted  force/torque  sensor. 

Salisbury  (1980)  developed  stiffness  control,  a  new  approach  to  implementitng 
Cartesian  based  active  force  control.  In  Salisbury’ ‘s  approach,  a  Cartesian  stiffness 
matrix  is  transformed  into  joint  space,  permitting  rapid  routine  computation.  Salis¬ 
bury's  method  yields  a  joint  stiffness  matrix  from  a  specified  Cartesian  stiffness  matrix 
by  premultiplying  by  the  Jacobian  transpose  and  postmultiplying  by  the  Jacobian.  Un¬ 
like  the  approximate  method  of  Paul  and  Shimano  (1976),  joints  are  driven  to  achieve 
a  desired  Cartesian  stiffness  and  are  not  dedicated  to  either  force  or  position  control. 

Wu  and  Paul  (1980)  developed  and  implemented  a  joint  torque  sensor  for  a  single 
joint  manipulator.  The  feedback  loop  was  closed  around  the  joint’s  gear  reduction  unit. 
The  analog  control  system  used  was  capable  of  high  gain  and  bandwidth  although  the 
stability  problem  was  not  analyzed.  Wu  and  Paul  argued  that  good  force  sensing 
techniques  are  imperative  to  accurate  force  control  and  that  sensed  torque  is  more 
readily  integrated  into  a  control  scheme  than  wrist  sensor  force  data. 
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Mason  (1981)  presented  a  theoretical  analysis  of  force  control  in  Cartesian  space 
based  on  nat4iral  and  artificial  constraints.  Natural  force  and  position  constraints  are 
imposed  by  the  task  environment  and  determine  which  axis  can  be  force  controlled 
and  which  can  be  position  controlled.  Artificial  coastraints  specify  force  and  position 
trajectories  consistent  with  natural  constraints. 

Raibert  and  Craig  (1981)  implemented  another  approach  to  compliant  manipulator 
control.  Force  and  position  errors  specified  in  a  Cartesian  system  were  transformed  into 
joint  coordinates,  multiplied  by  the  joint  gain  matrix  and  used  to  command  force  and 
torque  at  the  joints.  Cartesian  force  and  position  errors  were  computed  based  on  force 
sen.sing  wrist  and  joint  position  sensor  feedback.  It  is  important  to  note  that  while  each 
Cartesian  degree  of  freedom  was  either  position  controlled  or  force  controlled,  actuator 
torque  commands  were  derived  from  superposition  of  both  the  force  and  position  control 
loops. 

Lull.  Fisher,  and  Paul  (1983)  implemented  closed  loop  torque  servos  at  the  joints 
of  the  Stanford  Manipulator.  The  feedback  was  utilized  to  reduce  frictional  effects  in 
the  joints  and  harmonic  drive.  Stability  is  discussed  and  a  phase-lead  compensator  is 
used  to  eliminate  limit  cycles  while  reducing  friction  torque.  The  research  addressed 
the  practical  need  to  reduce  frictional  effects  in  manipulator  joints  and  drives. 

Cannon  and  Rosenthal  (1984)  began  the  investigation  of  manipulator  control  with 
uon-colocated  actuators  and  sensors.  They  contended  that  with  colocation,  good  stable 


control  is  easy  to  achieve,  but  that  with  uon-colocated  sensors  and  actuators,  it  is  much 


14 


more  difficult,  especially  if  the  system  is  flexible  and  has  little  damping.  The  researchers 
fo\md  that  iiva  noncolocated  system,  “pole  zero  flipping"  occured  as  parameters  varied. 

Paul  (1985)  outlined  a  scheme  for  hybrid  control  of  robotic  manipulators  in  which 
the  contraint  surface  is  mapped  to  joint  axes.  Force  sensing  elements  are  used  and 
some  joints  are  torque  controlled  while  others  are  position  controlled. 

In  (85]  Whitney  reviewed  the  major  force  control  strategies.  He  included  stiffness 
control,  damping/accomodation,  impedence  control,  explicit  force  control,  hybrid  con¬ 
trol,  and  implicit  force  control  in  his  review.  He  analyzed  stability  and  concluded  that 
low  force  feedback  gain  is  required  when  dealing  with  high  environmental  stiffness^- 
Canuon,  Tilley,  and  Kraft  (1986)  investigated  end  point  force  control  of  a  flexible 
manipulator  with  non-colocated  sensors  and  a  fast  end  effector.  The  wrist  s\ibsystem 
utilized  endpoint  force  feedback  to  close  its  own  loop  on  contact  force.  The  wrist  force 
controller  treats  movement  of  the  main  link  as  a  disturbance  and  greatly  improves  the 
end  point  response  of  the  flexible  main  manipulator. 

Roberts,  Paul,  and  Hillberry  (1986)  looked  at  the  effect  of  eml  effector  mechan¬ 
ical  stiffness  on  maixipulator  control.  They  concluded  that  there  existed  an  inherent 
tradeoff  between  wrist  sensor  stiffness  aird  maniptUator  response  for  position  and  force 
control.  A  sensor  deflection  compensator  was  described  wliich  allowed  the  manipulator 
to  exhibit  the  same  stiffness  with  a  compliant  end  effector  as  it  would  have  without  the 
end  effector. 


Chae  An  (1986)  studied  force  control  of  the  MIT  Direct  Drive  .■Vrni  ( DDArml  and 
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addressed  kinematic  and  dynamic  instabilities  in  robot  force  control.  An  presented 
parameter  estimation  techniques  and  computed  and  feedforeward  torque  control  tech¬ 
niques.  He  described  stability  prol)lem8  associated  with  stiff  environment  contact  as  a 
dynamic  stability  problem  and  outlined  a  kinematic  stability  problem  associated  with 
Raibert  and  Craig’s  (1981)  hybrid  control.  An  contended  that  the  hybrid  control  tech¬ 
nique  of  Raibert  and  Craig  does  not  allow  one  to  kinematically  decouple  the  system 
eigenvalues.  For  revolute  robots,  the  eigenvalues  are  tied  to  position  and  therefore 
cannot  be  gtiaranteed  to  remain  stable. 

Eppinger  and  Seering  [86]  developed  a  dynamic  model  of  robot  force  control  with 
force  sensor  feedback.  In  modeling  some  effects  of  workpiece  dynamics  and  manipulator 
and  sensor  stiffness,  they  concluded  that  force-controlled  instabilities  may  result  from 
the  first  mode  of  the  manipulator.  In  following  work  (1987).  they  continued  to  study 
manipulator  instability  and  non-colocation.  They  concluded  that  dynamics  between 
the  actuator  and  force  sensor  lead  to  instabilities  when  the  force  loop  is  closed.  In 
addition,  they  pointed  out  that  actuator  lag  and  low  pass  filtering  limit  closed  loop 


bandwidth  and  lead  to  instabilities. 
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Chapter  2 

Brushless  Motors  and  Controllers 

2.1  Brushless  Motors 

Brushless  motors,  defined  for  this  research  as  electronically  commutated  permaiftnt 
magnet  DC  motors,  are  an  outgrowth  of  conventional  DC  motor  technology.  In  DC 
motors,  the  interaction  of  permanent  magnet  induced  magnetic  flux  and  phase  winding 
current  vectors  produce  torque.  Conventional  DC  motors  are  constructed  with  perma¬ 
nent  magnets  on  the  stator,  phase  windings  on  the  rotor,  and  internal  commutation 
brushes  to  meclia.nically  switch  motor  current.  The  commutation  brushes  effectively 
maintain  a  stationary  rotor  current  field,  properly  aligned  with  the  stator  magnetic 
field,  irrespective  of  rotor  position. 

In  brushless  motors,  phase  windings  are  located  on  the  stator  and  permanent  mag¬ 
nets  are  located  on  the  rotor.  Current  switching  is  controlled  by  electronic  commutation 
circuitry  external  to  the  motor.  Rotor  position  is  fed  back  to  the  motor  controller  from 
a  resolver,  an  encoder,  or  hall  effect  transducers.  Electronic  commutation  spacially 
orients  the  stator  phase  currents  with  the  rotor  field.  The  stator  current  field  is  rotated 
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to  follow  the  rotor.  In  order  to  acheive  this,  forms  of  commutation  range  from  simply 
turning  phases  on  or  off  based  on  rotor  position  feedback  to  continuously  varying  phase 
currents  as  the  motor  turns. 

Brushless  motors  have  many  advantages  over  conventional  DC  motors.  First,  the 
absence  of  brushes  greatly  reduces  mechanical  friction.  Second,  higher  winding  currents 
can  be  used  without  the  arcing  problems  associated  with  the  brushes  of  conventional 
motors.  Third,  replacing  rotor  coils  with  high  performance  magnets  reduces  rotor 
inertia  and  provides  improved  acceleration  and  dynamic  performance.  Finally,  the 
inverted  construction  of  a  brushless  motor  allows  heat  generated  from  winding  losses 
to  be  efficiently  removed  through  the  stator.  Normally,  copper  losses  are  the  major 
cause  of  heating  in  the  motor.  Temperature  rises  limit  the  load  that  a  motor  can  drive 
because  winding  insulation  normally  breaks  down  at  about  155"  Celsius.  In  briishless 
motors,  due  to  efficient  heat  dissipation  via  conduction,  winding  currents  are  less  limited 
by  restrictions  on  nijudmum  winding  temperature.  Conventional  DC  motors,  on  the 
other  hand,  are  restricted  to  lower  winding  currents  because  heat  must  be  dissipated 
from  the  rotor  by  convection  zdone. 

In  addition  to  benefits  accruing  from  their  basic  design,  brusliless  motors  offer 
several  advantages  stemming  from  use  of  Pulse  Width  Modulation  (PWM)  techniques 
and  modern  rare  earth  magnetic  materials.  PWM  allows  bruslUess  motors  to  be  driven 
extremely  efficiently.  With  PWM,  phase  winding  currents  are  continuously  varied  by 
switchixrg  the  power  transistors  on  and  off  at  high  frequeixcy.  The  motor  pliases  see 


18 


an  average  voltage  that  is  a  function  of  the  duty  cycle,  or  percentage  of  time  that  the 
transistors  are  on.  PWM  results  in  high  efficiencies  because  the  power  transistors  are 
always  full  on  oi  full  off. 

Rare  earth  magnets,  in  particular  Samarium  Cobalt  magnets,  allow  higher  torque 
ratings  and  snore  nearly  linear  torque  response.  The  increased  torque  ratings  arise 
from  the  extremely  high  energy  product  of  materials  like  Samarium  Cobolt.  Samarium 
Cobolt’s  high  coercivity  lends  itself  to  high  field  strengths.  The  torque  response  is  more 
linear  because  Samarium  Cobolt  has  a  relatively  low  reversible  temperature  coefficient 
(approximately  -0.04  %)  and  a  high  resistance  to  the  temporary  demagnetizatioiwef- 
fects  of  armature  reaction.  The  reversible  temperature  coefficient  is  a  measure  of  the 
drop  in  magnetic  field  Hux  strength  as  a  function  of  temperature.  Armature  reaction 
demagnetization  is  a  reversible  process  in  which  the  motor  magnets  are  demagnetized 
due  to  the  interaction  with  the  magnetomotive  force  (MMF)  induced  by  the  statoi 
windings. 

2.2  Brushless  Motor  Controllers 

Brushless-  motor  controllers  contain  the  electronics  to  commutate  brushless  motors. 
In  addition,  circuitry  can  be  included  to  control  velocity,  torque,  or  position.  Figure 
3.1  illustrates  the  various  components  and  structure  of  a  generalized  brushless  motor 
controller. 

The  controller  is  provided  with  position  feedback  from  a  shaft  mounted  brushless 
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Figure  2.1.  A  common  brushless  motor  controller  configuration. 


resolver.  The  resolver  output  is  converted  to  a  digital  shaft  angle  and  used  to  select 
relative  phase  current  magnitudes  in  lookup  tables.  The  values  from  the  lookup  table 
are  scaled  by  the  current  command  and  given  to  the  current  control  loops  for  each 
phase.  The  current  command  is  prupurtioual  to  desired  torque.  In  a  t4)rque  controller. 
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the  desired  torque  is  the  input  to  the  controller.  In  a  velocity  controller,  the  torque 
command  is  -calculated  by  the  velocity  control  loop,  based  on  the  desired  and  actual 
velocity. 

The  ROM  lookup  tables  provide  the  shape  of  the  commutated  phase  current  wave¬ 
form.  In  a  sinusoidal  commutation  scheme,  the  tables  contain  sinewaves  corresponding 
to  the  spacial  harmonics  of  the  motor.  The  tables  allow  one  to  modify  the  phase  current 
profiles  to  modify  motor/ controller  performance. 

The  current  control  loop  senses  the  phase  current  with  inline  resistors  or  hall 
effect  devices.  The  sensed  value  is  compared  with  the  the  desired  value  output  by^he 
Multiplying  Digital  to  .Analog  Converters  (MDACs).  The  current  loop  controls  the 
PWM  of  the  power  stage  in  order  to  acheive  the  commanded  current. 

It  is  interesting  to  note  that  brushless  motors  have  fewer  armature  coils  than 
conventional  DC  motors.  This  is  a  function  of  implementation  cost.  Each  armature 
phase  requires  2  to  4  power  transistors  and  the  accompanying  circuitry  to  drive  them. 
It  is  therefore  considered  cost  prohibitive  to  add  armature  coils  in  the  quantity  found 
on  conventional  motors.  As  a  result,  most  brushless  motors  are  built  in  two  and  three 
phase  configurations. 

2.3  Moog  Brushless  Motor  and  Torque  Controller 

The  Moog  motor  used  in  this  research  is  3  phase  wye  connected.  There  are  8  Samarium 
Cobolt  motor  poles  mounted  on  an  internal  rotor.  Shaft  position  feedback  is  provided 
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by  a  brushless  resolver  attached  to  the  end  of  the  rotor  shaft.  The  motor  is  capable 
of  delivering-15  in.lb.  continuous  and  60  in.lb.  peak  torque.  The  motor  constant  is 
approximately  27  oz-in/ \/W. 

The  controller,  shown  in  Figure  2.2  mounted  in  an  equipment  rack  alonside  its 
power  supply,  is  configured  for  torque  control.  The  3  phases  are  sinusoidally  driven 
by  320  volt  5kHz  PWM  current  drivers.  The  current  amplifiers  can  provide  15  amps 
continuous  and  30  amps  peak  current.  Peak  output  power  is  therefore  approximately 
10  kW.  The  resolver  to  digital  converter  provides  12  bit  shaft  position  data  and  a 
velocity  signal.  While  the  motor  is  mechanically  capable  of  spinning  up  to  11,000  rpm, 
the  controller  is  configured  for  high  resolution  commutation  and  cannot  drive  it  above 
500  rpni. 

The  combined  torque  bandwidth  of  the  controller /motor  combination  is  approxi¬ 
mately  90  Hz.  The  90  Hz  cutoff  is  a  result  of  the  motor  inductance  limiting  response 
time.  While  the  mechanical  time  constant  of  the  motor  is  =i:1.0  mSec,  the  electrical 
time  constant  is  ^1.72  mSec. 

The  controller  could  be  reconfigured  to  drive  almost  any  3  phase  brushless  motor 
subject  t»>  its  power  and  voltage  limitations.  In  order  to  do  this,  the  commutation 
electronics  would  have  to  he  modified  to  account  for  the  motor  pole  count  and  the 
current  loops  would  have  to  be  tuned  to  be  stable  driving  the  new  motor  windings. 
X  complete  specification  sheet  and  perfunuaiice  curve  for  the  Moog  equipment  ami  a 
dimension  sketch  for  the  Moog  motor  is  provided  in  Appemiix  I. 


Figure  2. ‘2  The  Moog  Torque  Controller  and  Power  Supp.y. 


AD-/^  4^^/%ISSING  pages  will  be  inserted  AT' an  later  date  as 
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Minsky  (1981)  presented  an  argument  for  endpoint  sensing  in  force  control.  He 
dismissed  joHit  torque  control  due  to  perceived  limitations  in  the  ability  to  accurately 
identify  and  control  inertial  forces  and  the  lack  of  resolution  caused  by  noise  in  the 
joints.  Minsky  proposed  that  an  endpoint  sensor  be  combined  with  a  “relaxed  wrist” 
to  control  contact  forces.  As  envisioned,  a  “relaxed  wrist”  would  be  a  device  with  at 
least  3  degrees  of  freedom  that  could  enable  a  manipulator  to  exhibit  high  compliance 
at  its  endpoint. 

The  concept  of  a  “relaxed  wrist”  is  remarkably  similar  to  the  work  performed  by 
Canon  et  al  (1986)  on  fast  end  effectors.  The  fast  end  effector  was  attached  to  the  end 
of  a  flexible  manipulator.  Contact  forces  were  controlled  by  an  endpoint  sensor  and 
a  force  control  loop  closed  around  the  fast  end  effector.  In  this  way,  the  force  control 
loop  did  not  contain  the  dynamics  of  the  whole  manipulator  allowing  contact  forces  to 
be  more  readily  controlled. 

The  re.search  indicates  that  utilizing  a  wrist  force  sensor  and  closing  a  force  loop 
around  the  manipulator  dynamics,  limits  bandwidth  and  performance  of  contact  force 
control.  Force  control  loops  should  be  closed  more  tighly  around  the  fast  end  effectors 
of  Cannon  (1986),  the  “relaxed  wrists”  of  Minsky  (1981),  or  the  individual  manipulator 
joints.  Closing  torque  loops  at  the  manipulator  joints  appears  to  offer  much  promise 
in  providing  high  bandwidth  manipulator  performance  because  1)  There  are  fewer  en¬ 
closed  manipulator  dynamics  to  go  unstable,  2)  it  is  no  longer  necessary  to  insert  a 
large  compliaixce  between  the  manipulator  and  the  environment.  3)  the  inertial  param- 
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eters  can  be  identified  with  enough  accuracy  to  allow  good  control  of  contact  forces  (An 
1986),  4)  the  effects  of  large  joint  frictions  and  nonlinearities  can  he  greatly  reduced 
(Paul  (1983)),  and  5)  finally,  as  An  (1986)  demonstrated,  wrist  force  sensor  feedback 
can  still  be  utilized  to  increase  accuracy  in  a  joint  torque  control  system  without  leading 
to  dynamic  instabilities.  Therefore,  it  seems  clear  that  one  aspect  of  research  in  force 
control  should  concern  itself  with  developing  robust,  repeatable,  and  accurate  torque 
sources  for  use  in  force  control  implementations.  The  remainder  of  this  thesis  discusses 
issues  iiivolved  with  the  accurate  torque  control  of  brushless  motors. 

lb 

3.2  Torque  Measurement 

One  approach  to  torque  control  is  to  utilize  a  torque  sensor  and  close  a  torque  loop. 
This  approach  has  been  taken  several  times  (Paul  and  \Vu  (1980).  Luh,  Fisher,  and 
Paul  (1983).  Dal{j;ett,v  (1984).  and  Lim  (1985)).  Paul’s  work  involved  designing  and 
implementing  joint  torque  sensors  for  the  Stanford  manipulator.  The  sensors  were 
strain  gauge  based  and  were  used  primarily  to  close  a  torque  loop  around  harmonic 
drives  in  order  to  reduce  joint  friction  effects.  Dalgetty  and  Lim  both  built  torque 
sensors  to* be  fitted  to  the  MIT  Direct  Drive  Arm  (DDarm).  Both  designs  were  based 
on  cantilever  beams  mounted  to  the  motor  shaft.  Dalgetty’s  design  con.sisted  of  an 
interesting  dual  sensitivity  sensor.  Unfortunately,  the  system  was  tough  to  calibrate  and 
difficult  to  use.  Dalgetty  (1984)  also  investigated  the  coupling  effects  of  sensor  stiffness 
with  inanipulatoi  dynamics  and  performance.  Lim  implemented  a  stiffer  sensor  which 
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exhibited  good  linearity  and  repeatability.  He  also  developed  a  stable  analog  torque 
controller  which  reduced  the  .standard  deviation  of  the  mean  output  torque  to  0.1  %  . 
Lim  reported  that  the  uncompensated  Direct  Drive  Motor  ha<l  ripples  of  ±o0  '•(  of  the 
mean  output  torque  at  the  frequency  of  the  motor  pole  pairs. 

The  first  aspect  of  my  research  involved  designing  two  torque  sensors.  The  first 
sensor  was  a  rotation  limited  fixture  designed  to  measure  motor  outpixt  torque  as  a 
function  of  angle.  The  sensor  served  as  a  tool  to  sttidy  the  uonlinearities  in  brushless 
motor  torque  and  as  a  prototype  to  familiarize  myself  with  issues  in  sensor  design.  The 
construction  of  the  first  sen.sor  contributed  a  great  deal  to  the  successful  design  and 
assembly  of  the  joint  torque  seusor  that  followed. 

Shimano  and  Roth  (1976)  listed  several  attributes  of  a  good  seusor  design.  They 
indicated  that  a  seusor  should  exhibit  high  stiffness,  compact  construction,  good  linear¬ 
ity.  aiid  low  hysteresis  and  internal  friction.  For  the  first  seusor,  it  wa,s  only  necessary 
to  match  output  torque,  acheive  good  linearity  and  low  hysteresis,  and  reasonable 
stiffness.  Compactness  of  design  was  not  really  an  issue. 

Torque  transducers  are  generally  divided  into  two  classes:  1)  inline  or  2)  reac¬ 
tion  typer  While  both  classes  involve  measuring  a  torque  induced  displacement  ,  inline 
sensors  produce  a  signal  based  vm  the  torque  transmitted  from  the  actuator  thru  the 
transducer  to  the  load.  Reaction  type  sensors,  on  the  other  hand,  typically  support 
the  actuator  or  load  and  measure  the  transmitted  torque  a.s  a  function  of  the  reaction 
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Th?  most  common  reaction  type  torque  transducer  is  the  torque  deflecting  table. 
Available  commercially,  the  transducer  supports  the  actuator  and  measures  deflections 
in  the  supporting  elements  in  order  to  infer  output  torque.  Deflection  measurement  is 
typically  acheived  with  strain  gauges  although  Velayudhan  (1984)  describes  a  torciue 
sensing  table  which  utilizes  a  differential  inductance  transducer  to  measure  displace¬ 
ment. 

In  this  research,  reaction  type  transducers  were  passed  up  in  favor  of  inline  designs. 
The  reason  for  this  was:  1)  The  use  of  reaction  transducers  necessitates  inclusion  of 
the  motor  housing  mass  in  the  sensor  dynamics  which  adversely  effects  performance. 
2 )  Development  of  a  reaction  type  sensor  might  preclude  integrating  the  motor  housing 
into  a  manipulator  structure.  3)  An  inline  sensor  could  offer  more  flexibilty  in  later 
sensor  placement  (i.e.  the  sensor  could  be  placed  on  any  shaft  iix  a  potential  reducer 
mechanism ), 

The  first  sensor,  shown  on  the  motor  shaft  in  Figure  3.1.  was  designed  as  an  inline 
caTitilever  beam  type  sensor.  In  the  sensor,  semiconductor  strain  gauges  are  used  to 
measure  deflection  ,  since  they  exhibit  high  sensitivity.  The  MicroGage  strain  gauges 
used  in  this  research,  have  a  gauge  factor  (change  in  resistance/ strain)  of  135  fl. 

The  sensor  design  involves  attaching  a  cantilevered  aluminum  beam  to  the  end  of 
the  motor  shaft.  .4  single  strain  gauge  mounted  on  either  side  of  the  beam  serves  as 
each  of  two  legs  in  a  Wheatstone  bridge.  Motor  torque  exerts  a  bending  moment  on 
the  beam  which  can  l.>e  measured  by  the  change  in  resistance  in  the  strain  gatxges.  .4xx 


Figure  3.1  The  experimental  fixture  used  to  measure  output  torques. 

AualoR  Devices  521  lustruiueutatioii  Amplifier,  accompanying  trim  pots,  and  precision 
resistors  to  serve  as  the  remaining  two  legs  of  the  Wheatstone  bridge  are  carried  on  a 
circuit  board  attached  to  the  cantilever  beam.  The  location  of  the  amplifier  electronics 
is  aimed  at  minimizing  noise  absorbed  by  the  signal  wires  before  the  signal  can  be 
amplified^.  Shielding  is  only  providetl  on  the  cable  connecting  the  amplifier  to  the  A  D 
converter.  The  bridge  supply  voltage  is  5  volts. 

Fixturing  is  included  to  allow  output  torque  measurement  as  a  functioxi  of  motor 
shaft  angle.  The  collar  attached  to  the  motor  support  bracket  r.an  be  rotated  through 
several  turns  in  each  direction.  The  cantilever  beam  is  prevented  from  rotating  freely 
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by  two  dowel  pins  protruding  from  the  rotatable  collar.  The  pins  maintain  a  constant 
distance  from  the  motor  shaft  and  therefore  allow  the  cantilever  torque  sensor  to  be 
calibrated. 

The  Wheatstone  bridge  sensitivity  was  designed  to  be  s;  6mV/in.lb.  The  design 
allowed  1100  //in/in  strain  at  the  peak  motor  torque  of  60  in.lb.  The  amplifier  gain 
was  set  at  28  in  order  to  provide  a  full  scale  output  signal  of  ±10  volts.  A  complete 
presentation  of  the  cantilever  sensor  design  equations  is  given  in  Appendix  II. 

Several  lessons  were  learned  from  the  design,  construction,  and  operation  of  the 
first  sensor.  These  lessons  were  used  in  planning  the  joint  torque  sensor.  First,  in  order 
to  double  torque  sensitivity,  each  leg  of  the  Wheatstone  bridge  should  consist  of  an 
active  strain  gauge.  Second,  each  set  of  four  gauges  should  be  temperature  coefficient 
matched  so  that  the  effect  of  thermal  drift  in  the  sensor  gauge  factors  is  canceled  out 
by  the  bridge  configuration.  Third,  the  bridge  itself  and  accompanying  electronics 
should  be  shielded  from  EMI  noise.  Fourth,  wire  leads  connecting  the  bridge  to  the 
amplifier  should  be  as  short  as  possible.  Finally,  the  electronics  should  utilize  fabricated 
copper  trace  boards  and  avoid  wire  wrapping  in  order  to  reduce  noise  and  prevent  short 
circxiits.  _ 


3.3  Development  of  a  Joint  Torque  Sensor 

The  joint  torque  sensor  was  designed  to  provide  good  torque  sensing  characteristics, 
unlimited  rotation,  and  compatibility  with  the  cable  driven  manipulator  design  devel- 
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oped  in  our  lab.  The  last  criteria  involved  designing  a  sensor  which  could  fulfill  the 
functions  of  the  motor  output  pulley  of  the  cable  driven  manipulator.  The  pulley, 
shown  in  Figure  3.2,  served  several  purposes  in  the  manipulator  design:  1 )  Provide  a 
solid  connection  with  the  motor  shaft  (and  prevent  noiilinearities  such  as  backlash).  2) 
Transmit  power  to  the  manipulator  through  the  attached  cables.  3)  Allow  attachment 
and  tensioning  of  the  manipulator  cables  through  relative  rotation  of  the  pulley  halves. 
4)  Provide  the  3/4  inch  outer  diameter  required  to  achieve  the  overall  manipulator 
reduction  ratio. 


Figure  3.2  The  output  pulley  on  the  cable  driven  manipiiSator. 

In  order  to  acheive  a  high  level  of  performance,  the  design  was  approached  from  a 


systems  standpoint.  It  was  important  to  optimize  the  the  mechanical  sensing  element. 


the  amplifying  electronics,  the  electrical  transmission  system  (inchuling  shielding),  and 
the  system  as  a  whole,  in  order  to  achieve  high  quality  torque  sensing.  A  photograph 
of  the  completed  sensor  is  shown  in  Figure  3.3.  Figure  3.4  is  a  cutaway  schematic  of 
the  sensor. 


Figure  3.3  The  joint  torque  sensor. 

The  mechanical  sensing  element  was  designed  to  provide  a  linear  output  proportional 
to  motor  torque  as  well  as  to  reject  the  effects  of  transverse  loading,  bending  moments, 
and  axial  thrust.  Effort  was  also  made  to  minimize  overall  rotational  inertia  of  the 
sensing  element.  By  limiting  inertia,  the  acceleration  performance  of  the  cable  driven 


manipulator  would  not  be  overly  reduced  by  the  addition  of  the  seu.sor.  In  addition, 
it  was  important  to  avoid  creating  new  low  frequency  vibration  inodes  involving  the 
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Figure  3.4  A  schematic  of  the  torque  sensor  showing  cross  sections  of  the  main 
components. 

sensor  mass  and  its  compliance  or  coupling  with  the  manipulator  dynaniics  (Dalgetty 
1984)  which  would  adversely  affect  manipulator  control.  The  resulting  design  is  shovcu 
in  Figure  3.5. 

There  are  six  stainless  steel  parts  in  the  mechanical  sensing  elexnent.  An  exploded 
assembly  is  presented  in  Figure  3.6.  The  torque  shaft  couples  to  the  motor  shaft, 
provides  the  inner  race  for  the  caged  needle  bearing,  aiul  alk>\vs  connection  of  flie 
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Motor  Shaft  Keyway 


Figure  3.5  The  mechanical  sensing  element. 

amplifying  electronic.s  aiul  slip  ring.  The  gauge  shaft  is  Loctitecl  to  the  torcjue  shaft  at 
one  end.  It  is  the  gauge  shaft  that  contains  the  thinued  hollow  circular  gauging,  tortjue 
sensing  section.  Torque  is  transmitted  down  the  torque  shaft,  across  the  Luctited  joint, 
throtigh  the  gaged  gauge  shaft  section,  and  out  through  cables  attached  to  the  gauge 
shaft.  The  end  of  the  gauge  shaft  with  the  cables  is  supported  by  a  needle  roller  bearing 
in  order  to  allow  large  transverse  loads  on  the  sensor.  Like  the  torque  shaft,  the  gauge 
shaft  serves  as  a  bearing  raceway  and  is  precision  ground  for  accuracy. 

The  pulley  sleeve  can  be  rotated  relative  to  the  gauge  shaft  so  that  cable  ca.n  be 
taken  up  and  cable  tension  adjusted.  Holes  are  machined  in  the  pulley  sleeve  and  gauge 
shaft  where  the  cables  are  terminated  and  attached  to  the  torque  seu.sor.  The  locknut 
is  tightened  in  order  to  secure  the  pulley  sleeve  to  the  gauge  shaft  and  maintain  cable 
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/ 

Figure  3.6  .4n  exploded  view  of  the  mechanical  sensing  element. 

% 

tension.  The  locknut  also  provide.s  an  edge  on  which  to  seat  the  disk  portion  of  the 
EMI  shield  enclosing  the  strain  gauges  aird  accompanying  electronics.  Finally,  the  hex 
head  on  the  gauge  shaft  facilitates  cable  tensioning. 

Two  complete  strain  gauge  based  Wheatsone  bridges  are  located  on  the  gauge 
shaft.  The  gauges  are  cemented  on  the  outer  surface  of  the  gauge  section  in  the  pattern 
illustratetl  in  Figure  3.7.  In  each  bridge,  two  .strain  gauges  are  mounted  at  45"  relative 
to  the  shaft  axis  and  the  other  two  are  are  mounted  at  135°.  This  orientation  allows 
the  gauges  to  measure  the  maximum  tensile  and  compressive  strains  caused  by  applied 
shaft  torque.  At  the  same  time,  the  orientation  is  not  sensitive  to  strains  caused  by 
bending  moments  and  axial  loads. 

The  gauge  portion  of  the  gauge  shaft  is  0.006  in.  thick.  At  a  peak  torque  of 


GO  iii.lb..  each  gauge  is  subjected  to  a  strain  of  1000  pixi/in.  As  with  the  static  toripie 


36 


Edge  Toward  Slip  Ring 

1  +Signal  1  +10  Volts  -Signal  1  Ground 


I _  Ground _  +Signal  2  _  ^10  Vol^s  _  _ -Sjgnal  2 

Edge  Toward  Pulley 


Signal  1  -Signal  2 


+Signal  1  +Signal  2 


Figure  3.7  Strain  gauge  layout  on  the  gauging  surface. 

sensor,  this  strain  level  is  the  maximmn  level  recommended  by  Microgage  for  well  de¬ 
fined  peak  loadings.  While  torque  loadings  on  the  manipulator  are  not  well  defined 
due  to  unanticipated  impact  and  inertia  loadings,  it  is  felt  that  the  compliance  of  the 
cables  protects  the  sensor  against  overloads.  The  resulting  torque  sensor  sensitivity  is 
^  lOmV/iu.lb,  and  is  amplified  to  170  mV/in.lb.  by  the  instrumentation  ampli¬ 
fier.  The  stress  equations  and  design  formulas  for  the  joint  torque  mechanical  sensing 
clement  are  provided  in  Appendix  III. 

At  the  outset  of  the  design,  it  was  decided  to  utilize  a  slip  ring  to  transmit  power 
and  signals  to  and  from  the  rotating  torque  sensor.  .4  rotarv  transformer  was  ruletl 
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out  in  order  to  linxit  electronic  complexity  and  required  signal  conditioning.  Unfortu¬ 
nately,  slip  ripgs  were  known  to  produce  white  noise,  mechanical  friction,  and  vibration 
problems.  White  noise  is  undesirable  because  it  degrades  signal  quality  and  it  is  not 
band  pass  filterable.  This  problem  was  addressed  by  amplifying  each  signal  before  the 
slip  ring  and  by  running  each  signal  over  four  slip  ring  channels  simultaneously  and 
passing  supply  voltages  through  three  channels.  Redundant  channels  serve  to  reduce 
signal  noise. 

The  friction  problem  was  minimized  by  the  slip  ring  manufacturer  Michigan  Scien¬ 
tific.  which  handpicked  a  slip  ring  from  stock  with  a  breakaway  torque  of  less  than  one 
oz.in.  Finally,  the  eccentricity  induced  vibration  problem  was  reduced  by  designing  an 
EMI  shield  which  served  to  center  the  slip  ring  on  the  sensor  axis. 

The  cylindrical  EMI  shield  is  positioned  on  the  sensor  by  the  protruding  shoulder 
of  the  torque  shaft.  Bolted  in  place,  the  shield  supports  and  locates  the  20  channel  slip 
ring.  Three  hollowed  bolts  run  throtigh  the  slip  ring  and  the  EMI  shield  to  the  amplifier 
circuit  b(jard.  Power  and  signal  lines  are  routed  through  the  bolts  to  the  sensor  elec¬ 
tronics.  Another  EMI  shield  covers  the  opening  of  the  cylindrical  shield.  Both  shields 
are  constructed  of  an  iron  and  copper  laminate  glued  to  the  outside  of  A3S  plastic 
support  components.  The  laminate  was  donated  by  Chonierics,  of  Hudson.  MA  anti  i.s 
designed  to  attenuate  both  magnetic  (iron)  and  electric  (copper)  field  interference. 

The  sensor  electronics,  pictured  in  the  photo  of  Figure  3.8.  are  motmt.'’(l  on  an 


annular  circuit  board.  Two  surface  mount  .\D  024  insf  rumeutation  amplifiers,  wiiich 


Figure  3.8  The  joint  sensor  electronics. 


have  iiuprovetl  operatiug  fharacteristicii  compared  to  the  AD  o21  lAs.  amplify  the 
output  signal  of  each  Wheatstone  bridge.  The  board  also  carries  input  and  output 
trim  pots  and  bypass  capacitors  to  filter  the  supply  voltages.  The  annular  board 
was  commercially  fabricated  to  insure  its  electrical  and  mechanical  integrity  during 
operation.  It  should  be  noted  that  the  amplifiers  were  located  on  the  rotating  portion 
of  the  sensor  for  two  reasons:  1 )  A  design  goal  had  been  to  amplify  the  bridge  signals 
as  soon  as  possible.  2)  It  was  desired  to  increase  the  magnitude  of  the  signal  before 
the  added  noise  of  the  slip  ring  channels. 


Figure  3.9  The  completed  tor<(ue  sensor  mounted  on  the  Moog  motor  and  integrated 


into  the  cable  driven  manipulator. 

3.4  Signal  Noise  Reduction 

Signal  noise  EMI  generated  by  the  320  volt  PWM  controller  was  a  large  problem 
that  had  to  be  addressed.  In  certain  areas  in  our  lab,  the  5  kHz  PWM  was  capable 
of  generating  voltage  spikes  oxi  the  order  of  50  volts  in  the  surrounding  signal  lines. 
Theoretically,  a  2-pole  Butterw’orth  active  low  pass  filter  could  have  removed  the  noise. 
Such  a  filter,  with  a  cut  off  frequency  of  50  Hz  would  reduce  the  noise  80  dB  by  design. 
Unfortunately,  the  PWM  noise  was  everywhere.  A  filtered  signal  would  have  picked 


up  unacceptible  levels  of  noise  between  the  tilter  and  the  A,  D  converter.  In  addition. 
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-  System  Ground 


Figure  IJ.IO  Scliematic  of  the  shielding  system  used  in  the  lab. 

it  was  desired  to  avoid  low  pass  filtering  on  the  torque  sensor  in  order  to  avoid  the 
restiltant -phase  lags  and  controller  instability  problems  (Eppinger  (1986)). 

Another  approach  involved  shielding  both  the  EMI  sources  and  the  signal  and 
voltage  wires.  Denny  (1986)  provides  a  good  reference  for  shielding  implementations. 
Figure  3.10  shows  a  schematic  of  the  shielding  system  tised  to  reduce  EMI  in  the  motor 


control  system. 
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Fotir  major  steps  provided  excellent  results  in  reducing  noise:  1)  A  grounding  bus 
bar  was  bolted  to  the  equipment  rack  providing  a  low  resistance  grotinding  plane.  2) 
The  bottom  of  the  controller  where  the  motor  phase  cables  are  connected  was  enclosed 
m  a  metal  box.  3)  The  motor  power  cable  was  sheathed  with  braided  copper  cable, 
including  a  second  layer  at  the  outboard  end.  Initially,  the  cable  had  a  single  sheath 
and  was  grounded  to  the  equipment  rack,  but  in  order  to  improve  results  and  more 
completely  attenuate  the  escaping  noise  near  the  torciue  sensor,  a  second  layer  was 
added  and  the  shielding  was  grounded  to  the  motor  housing.  While  such  a  double 
ground  is  considered  had  practice,  it  improved  signal  quality  significantly.  4)  The  EMI 
shields  on  the  motor.  Including  both  slip  ring  housings,  w’ere  carefully  grounded  back 
through  the  slip  ring,  along  the  torque  sen.sor  cable  shields,  to  the  equipment  rack.  The 
mechaniccil  torque  sensor,  and  therefore  the  motor  shaft,  were  also  grounded  through 


this  rotito  to  maximize  noise  attenuation. 
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Chapter  4 

Current  Based  Torque  Control 

4.1  Torque  Inference  from  Phase  Currents 

Many  researchers  have  utilized  current  sensing  to  infer  motor  torques.  Paul  (1973), de¬ 
veloped  a  simple  joint  sensing  technique  which  utilized  a  relationship  between  currents 
and  joint  torques.  Asada  (1983)  noted  that  torque  produced  by  the  DDARM  motors 
could  be  estimated  from  the  phase  currents.  Asada  (1984)  went  on  to  state  that  with 
a  standard  equation  of  t)ie  form; 

T  --  cos(  nd)  Ib  cos(  nd  +  120")  cos(  nO  -  120"  )]  (4.1) 

where  and  A  are  the  phase  currents,  Kt  is  the  torque  constant,  n  is  the  number 
of  motor  pole  pairs,  and  6  is  the  mechanical  angle  of  the  motor  shaft,  one  could  achieve 
torque  control  within  +/-10%  on  the  DDARM.  He  noted  that  the  unmodeled  error 
arose  from:  a)  variation  in  the  magnetic  field  in  the  air  gap,  b)  distortions  of  the 
sinusoidal  phase  currents,  and  C)  variations  in  the  current  sensing  resistors.  Finally,  he 
reported  (1984)  that  if  the  above  equation  was  modified  to  account  for  rotor  and  stator 
slots,  torque  error  could  be  reduced  to  -  -6%  f>f  the  mean  torque.  Uufortunatelv.  he 
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did  not  outline  the  method  used  to  compensate  for  rotor  and  stator  slots. 

Lim  (1985)  noted  that  while  torques  on  the  DDARM  could  be  estimated  using  cur¬ 
rent  sensing  techniques,  significant  torque  ripple  and  deadband  nonlinearities  degraded 
control  performance.  He  noted  that  the  nonlinearities  were  generally  difficult  to  ac¬ 
curately  identify  and  recommended  that  a  torque  sensor  was  necessary  for  precision 
torque  control  of  the  DDARM. 

.A.n  (1986)  ignored  the  nonlinearities  of  ciirrent  based  torque  sensing  and  utilized 
the  technique  in  his  thesis  research.  Torques  inferred  from  phase  current  sensing  were 
used  for  inertial  parameter  estimation  and  feedforward  torque  control  implementation. 
-4n  (1986)  reported  that  his  force  control  scheme,  utilizing  joint  torque  control  and 
wrist  force  sensor  feedback,  exhibited  limits  in  accuracy  attributable  to  torque  ripple, 
deadband,  and  cogging  torque. 

4.2  Sources  of  Torque  Ripple 

Many  fingers  are  pointed  when  the  sources  of  torque  ripple  in  brushless  motors  are 
described.  Some  point  to  stator  slots  causing  variations  in  air  gap  reluctance  which  lead 
to  cogging  torque.  Others  point  to  saturation  of  iron  laminations  in  the  magnetic  circuit 
or  degradation  of  the  magnetic  flux  due  to  the  temperature  dependence  of  the  magirets. 
Others  point  to  controller  nonlinearities,  and  finally,  others  attribute  torque  ripple  to 
nonsymmetric  demagnetization  of  rotor  magnets  due  to  armature  reaction  ( Aha  ( 1987). 
Ferret.  Le  Huy.  and  Feuillet  (1986).  and  .A.sada  and  Tounu  (1987)).  L  udoubtedly.  all 
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of  these  factors  play  some  role  in  the  production  of  torque  ripple.  It  is  also  pretty 
clear  that  different  factors  assume  different  degrees  of  importance  depending  on  the 
individual  application.  It  is  my  contention  that  in  the  interests  of  accurate  torque 
control,  the  major  factors  should  be  accurately  identified  and  compensation  techniques 
should  be  developed  when  possible. 

My  research  has  shown  that  it  is  possible  to  utilize  compensation  techniques  anti 
phase  current  waveform  modification  to  provide  accurate  torque  control  based  on  phase 
current  sensing.  Experimental  results  have  indicated  that  accurate  motor  torque  control 
can  be  accomplished  through  precise  current  sensing  and  control.  In  my  lab  work  with 
a  Moog  brushless  motor  and  controller  the  most  significant  causes  of  torque  ripple 
have  been  identified.  With  this  knowledge,  it  has  been  demonstrated  that  a  significant 
portion  of  the  torque  ripple  can  be  removed.  While  some  of  the  corrections  have  a 
transient  benefit  and  lose  their  effect  over  time,  their  initial  effectiveness  indicate  that 
with  controller  modifications,  the  technology  is  now  available  to  accurately  control 
Ijrushlcss  motor  torque  through  current  control. 

Figure  4.1  shows  experimental  data  of  the  torque  ripple  on  an  uncompensated 
Moog  303-003  motor  as  a  function  of  shaft  angle.  In  the  following  paragraphs,  I  will 
attempt  to  outline  the  major  factors  contributing  to  this  ripple.  Accompanying  the 
description  of  each  factor,  is  a  similar  figure  showing  an  experimental  measurement  of 
the  associated  ripple.  The  ripple  magnittide  is  noted  as  a  percentage  of  mean  ourput 
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RMS  Noise:  5.5  mV/V 
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Figure  4.1  Torque  ripple  characteristics  of  the  Moog  controller  and  motor  combina¬ 
tion  without  compensation. 


Torque  ripple  coiupoueuts  iu  the  output  of  the  Mooi?  303-003.  can  he  divuled 


46 


into  two  categories:  1)  ripple  attributable  to  effects  originating  in  the  motor  controller 
and  2)  ripple  resulting  from  the  motor  configuration  and  construction.  In  order  to 
understand  these  effects,  we  must  investigate  the  equation  most  commonly  used  to 
describe  the  torque  output  of  a  S-phase  brushless  motor  as  a  function  of  phase  current. 
However,  in  the  interest  of  clarity,  we  will  present  the  equation  in  a  slightly  different 
form: 

T  =  Iu[h  h  Ic][Sa  56  (4.2) 

where  t  is  the  output  torque.  Kt  is  the  torque  constant,  /a, A. and  /<•  are  the  phase 
currents,  and  5a. 56. and  5<.  are  the  spacial  harmonics  of  the  motor  corresponding  to 
each  phase.  Typically,  the  spacial  harmonics  are  defined  as: 

Sa  =  cos(nd) 

Sb  =  cos(n^  +  120°)  (4.3) 

Sc  =  cos(  n9  -  120  ’ ) 

where  n  is  the  number  of  motor  pole  pairs  and  9  is  the  mechanical  angle  of  the  motor 
shaft.  Given  the  3-phase  wye  connection  of  the  motor.  Ir  is  constrained  according  to 
Kirchoff’s  current  law  as: 

Ic  =  -(Ia+h)  (4.4) 


Most  motors  are  driven  with  a  first  order  approximation  of  the  phase  current  waveforms 
needed  for  linear  torque  prodiiction.  The  first  order  approximation  is: 


/a  "=  Icnr,{n$) 

h,  -  I  COM  n 9  -  120  ' ) 


(4..yi 
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Giveti  the  above  assumptions,  the  comp\itetl  theoietical  torque  is, 

r=?A\/  (4.6) 

and  independent  of  B.  A  more  meaningful  derivation  of  the  torque  equation  results  if 
one  defines  the  phase  currents  in  the  following  way: 

la  —  Acos{n6)  +  6a 


(4.7) 


h  -  B  cos(  nB  +  120'’ )  -I-  6(, 

allowing  offset  errors  and  relative  waveform  magnitudes  to  l)e  included  in  the  derivation 
of  T.  The  physical  constraints  of  the  motor  windings  insure  that  Equation  4.4  applies 
regardless  of  the  individual  current  waveforms.  Therefore,  by  defining  the  currents  in 
phase  a  and  phase  b  we  have  uniquely  defined  the  ciirrent  waveform  in  phase  c.  Given 
Equations  4.2,  4.4,  and  4,7,  the  output  torque  becomes, 

r  =  —^(.4  cos'  B  B  sin'  B) 

^  y-^{B  -  A)sm{2B)  (‘*•8) 

4 


-  V3(^  sin(^  ^  120°)  -  ^6  sin(t?)) 

If  the  two  phase  current  waveform  magnitudes.  A  and  B.  are  equal  to  a  given  vahie  I 
and  6a  and  6(,  are  zero,  then  the  output  torque  reduces  to  the  value  given  in  Equation 
4.6.  On  the  other  hand,  if  the  waveform  magnitudes  are  unequal,  A  =  S  +  Aa,  andt 
6a  =  ^6  =  0  then: 


3,. 


sqrfZ 


r  =  -KtB  ^  -  A‘t  Aa  cos^  B - ; — A't  Aa  sin(2^) 

2  3  4 


(4.9) 


But  since  cos'  0  =  j  ’  cos  2^,  Equation  4.9  can  be  rewritten  as: 


r  =  - 


A.,  \o 


A',A„c(.s(2y  -  30'  ) 


o 


(4.10) 
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Equation  4.10  demonstrates  that  a  difference  in  the  current  waveform  magnitude  of 
two  phases  in  the  motor,  generates  a  torque  ripple  at  twice  the  fundamental  driving 
frequency  of  n^.  For  comparison  purposes,  a  5%  variation  in  the  phase  current  magni¬ 
tudes  will  cause  an  =r±3%  ripple  torque  at  a  frequency  of  2nt>.  In  the  Moog  303-003, 
such  a  ripple  would  cycle  at  80  and  have  a  magnitude  of  ==  ±7oz.iu.  at  continuous 
output  torque.  Figure  4.2  shows  the  8^  component  of  the  ripple  torque  for  the  Moog 
motor. 

The  2u^  ripple  derived  above  is  an  example  of  the  more  general  case.  By  superim¬ 
posing  an  ii0(,  siiiewave  on  a  primary  and  feeding  phase,  one  can  produce  a  2n^  output 
torcpre  ripple  at  any  30”  increment  phase  angle.  A  primary  phase  is  defined  here  as 
that  phase  whose  fundamental  waveform  magnitude  is  increased  by  the  addition  of  the 
nO^  sinewave  and  the  feeding  phase  is  defined  as  that  phase  which  provides  the  pathway 
for  the  nO^  sinewave  current  to  flow  to  the  primary  phase. 

The  imposed  ripple  magnitude  is  controlled  by  the  amplitude  r)f  the  superimposed 
aOf,  sinewave.  The  phase  of  the  ripple  is  a  function  of  the  primary  phase  (i.e.  phase  A 
in  the  derived  example)  and  the  feeding  phase  (i.e.  phase  c  in  the  derived  example).  In 
the  derived  example,  the  feeding  phase  was  chosen  by  default,  since  phase  B  was  not 
altered  and  wye  construction  requires  that  the  n^^  feeding  current  be  drawn  through 
phase  C.  The  phase  of  the  produced  ripple  can  be  controlled  to  a  greater  resolution  by 
apportioning  the  n^^  feeding  current  between  both  nonprimary  phases  and  therefore 
rotating  the  2n0  torque  vector  between  the  30”  increments. 
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Figure  4.2  The  2nd  Moog  motor  ripple  component. 


.Another  source  of  torque  ripple  arises  \vheii  the  fundamental  current  waveform  ot 


)ue  or  more  phases  i.s  offset  from  zero.  This  situation  is  modeled  bv  setting  and  B 
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equal  to  I,  but  letting  ba  7^  0.  We  obtain  the  following  result: 

i>  /o 

-KtA+  ~ KKi  sin(e  ^120'^)  (4.11) 

2  4 

Clearly,  the  waveform  offset  produces  a  ripple  at  the  fmulamental  frequency  u(r.  The 
relative  magnitude  for  a  5%  offset  would  be  ^±6%.  One  should  note  that  in  a  motor 
with  offsets  in  all  three  phases,  the  L-ffect  is  to  alter  the  phase  and  magnitude  of  the 
nO  ripple  without  affecting  its  frequency.  Figure  4.3  shows  the  4^  component  ripple  for 
the  Moog  motor. 

Current  loop  deadband  is  another  controller  nonlinearity  that  should  be  considered 
significant.  Theoretically,  it  is  difficult  to  model  current  loop  deadband  accurately. 
Therefore,  an  e.xperimental  approach  was  taken  in  which  deadband  was  simulated  in  the 
controller's  commutation  tables  and  the  resulting  motor  output  torque  was  analyzed. 
The  results,  indicate  that  ctirrent  loop  deadband  produces  torque  ripple  at  all  the 
integer  multiples  of  the  fundamental  phase  driving  freqiiency  n^.  Figure  4.4  slum's 
torque  measurement  results  for  the  Moog  motor  with  simulated  (via  table  alteration) 
deadbfiml  in  the  current  drivers. 

Some  of  the  torque  ripple  can  also  be  attributed  to  motor  construction.  My  re¬ 
search  indicates  that  the  most  siguiHcant  torque  ripple  arising  from  motor  construction 
is  caused  by  unmodeled  spacial  harmonics  arising  from  imperfections  of  the  physical 
implementation  of  the  fundamental  spaciid  harmonic.  The  unmodeled  harmonics  are 
actually  odd  harmonics  of  those  modeled  in  Equation  4.1.  The  fact  that  the  harmonics 
are  odd  results  from  the  symmetrv  of  the  tiiulerlviug  motor  construction.  Eciuation  4.3 
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Figure  4.4  Torque  ripple  resulting  from  deadband  in  the  current  drivers.  Note  that 


this  data  is  no)  a  component  of  Figure  4.1. 


S3 


should  be  represented  as: 

Sa  ~  S\  cos(n6)  +  53COs(3n^)  +  Sicos(^n^)  -f-  ... 

Sif  —  S\  cos(nfi  -p  120“)  -t-  S3  cos{3nt?)  4-  SiCos(5n/f  —  120“)  4  ...  (-l-l^) 


Sc  =■  Si  cos(n&  -  120“)  4  S3Cos(3n^)  4  Sscoslon^  —  120°)  ... 

where  Si  is  1.0  and  S3,  S5,  ...  are  given  as  normalized  values  in  relation  to  Si.  These 

odd  harmonics  induce  torque  ripple  iix  the  motor,  unless  compen.sating  higher  order 

waveforms  are  superimposed  on  the  fundamental  commutation  waveform.  Equation 

4.13  and  4,14  indicate  how  the  odd  harmonics  produce  torque  ripple  in  an  uncompen 

sated  system.  Equation  4.13  presents  the  oxitput  torque  with  the  spacial  harinohics 


modeled  and  tinmodified  fundamental  waveforms; 

r  r=  ^A’iJ[Si  —  Sscosidn^}  -  S7Cos(6n6>) 

4  Siicos(12n<?)  -  Si3COfl{  12nt^)] 


(4.13) 


Note  that  the  .spacial  harmonic  harmonics  of  order  3  and  multiples  thereof  do  not 


induce  riiiple  due  to  the  tiiree  phase  construction.  Now.  if  harmonic.s  are  added  to  the 


commutation  waveformo: 

T  =  -  At[/i  Si  4  /5S5  4  /7S7  4  /i  iSi  1  4  ...] 

4  -AMJiSs  -  /1S7  4  fsSi  -  I7S1  4  ...]cos(6u^) 

4  — A|[/iSil  —  /iSi3  4  /5S7  ~  /5S1 1  .. .]cos(  12u^) 


(4.14) 


Note  that  the  lowest  order  ripple  torque  produced  by  the  unmodeled  harmonics  is 
This  C(juiponenr  of  the  ripple  torque  for  the  Moog  mot»)r  is  shown  in  Figure  4.3. 


Motor  Torque  (ozin) 
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Figure  4.5  The  6n^  Moog  ripple  harmonic. 


If  one  assumes  that  oulv  the  fifth  am'  sev^uith  harmonic  of  the  fundamental  spacial 


hannonic  are  significant,  one  arises  at  Equation  4.15  to  describe  the  output  torque. 


r  =?AM/,S, -/.,55  ^/tSt] 

4-  ;^Kt\l\(S$  —  St)  -r  Sii/s  /t  God)  (4.15) 

4-  ^A'tl/jSt  r /TS5'Co.s(l2/}fl) 

The  odd  harmonics  can  be  identified  by  measuring  motor  torque  as  a  function  of  easily 
controlled  constant  phase  current  vectors.  For  example,  one  of  the  phases  can  be  phys¬ 
ically  disconnected  (this  protects  against  undetected  current  flows)  while  a  constant 
current  value  is  maintained  through  the  other  two.  The  resulting  torque  is  practically 
a  finger  print  of  the  complete  spacial  harmonics  of  the  motor.  By  performing  a  Fast 
Fourier  Transform  (FFT)  on  the  output  torque  as  a  function  of  motor  angle,  one  ob¬ 
tains  a  listing  of  the  relative  magnitudes  of  all  spacial  harmonics  within  the  sensitivity 
limitations  of  the  torque  sensor. 


Le-Huy,  Ferret,  and  Feuillet  (1986)  provided  a  very  good  description  of  harmonic 
induced  torque  ripple.  They  suggested  a  method  to  minimize  the  ripple  by  modify¬ 
ing  the  cemmutation  waveforms.  In  their  work,  they  identified  the  significant  spacial 
harmonics  of  a  3-phase  disk-type  brushless  motor  with  trapezoidal  flux  distribution. 
Their  approach  involved  monitoring  the  phase  winding  back  EMF  in  order  to  model 
the  spacial  harmonics  .  They  applied  their  technique  to  their  motor  and  reported  a 
70' '  reduction  in  tiic  lowest  frequency  haruumic  iiiduceil  ripple  component. 


4.3  Torque  Ripple  Compensation 


There  are  many  approaches  that  can  be  taken  for  torcpie  ripple  compensation.  The 
first  approach  taken  in  my  research  was  to  characterize  the  output  torque  and  s»*ale 
torque  cominauds  given  to  the  Moog  motor  controller  based  on  motor  rotor  position. 
In  order  to  accomplish  this,  a  looktip  table  was  as!-;embled  which  contained  the  effective 
motor  tor(iue  coustaur  at  various  motor  shaft  angles. 

It  was  desired  to  more  aocuratt-ly  identify  the  causes  of  torque  ripple  and  reduce 
their  effects  by  altering  the  commutation  waveforms.  By  accomplishing  this,  the  Moog 
motor  controller  would  become  a  black  box  that  would  produce  a  torque  proportional 
to  the  input  command.  Moreover,  the  modified  commutation  waveforms  would  imp'.ove 
torque  production  performance  and  attenuate  uios  A  the  nonlinear  effects  in  the  torque 
output. 

The  simplest  path  to  such  a  goal  involved  closing  a  torque  control  loop  around 
the  motor  and  controller,  driving  the  torque  controlled  controller/ motor  combination 
to  achieve  a  constant  output  torque,  and  then  recording  the  phase  current  waveforms 
for  later  USe  in  phase  commutation.  This  technique,  suggested  as  a  first  pass  type  so¬ 
lution  by  a  good  friend  Leo  Casey,  is  very  pragmatic  and  quite  effective  (as  outlined  in 
Chapter  5).  On  the  other  hand,  from  a  theoretical  standpoint,  the  approach  is  not  very 
clean.  The  problem  lies  in  the  fact  that  the  uncompensated  rf)ntroller  and  its  iiiherent 
nonlinearities,  are  driven  to  eliminate  those  same  uoiiliuearities.  The  end  restilt  is  that 
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the  form  o);  the  derived  couinmtatiou  waveforms  is  not  clearly  linked  to  the  resulting 
improvement  in  torque  control  linenrity.  The  clearest  example  of  this  is  the  fact  that 
phase  commutation  waveforms  produced  by  this  technique,  are  slightly  offset  in  phase 
angle  and  no  longer  correspond  in  phase  to  the  motor  spacial  harmonics.  Such  an 
effect  unnecessarily  lowers  overall  efficiency  and  obscures  the  fact  that  the  nonlineari¬ 
ties  are  not  caused  by  misorientation  of  commutation  phase  angles.  Overlooking  such 
arguments,  it  should  be  pointed  out  that  from  a  practical  standpoint,  this  technique 
provides  very  good  output  torqtie  linearity.  In  addition,  it  is  probably  the  best  practical 
technique  for  compensating  for  current  loop  deadband. 

The  final  technique  adopted  in  this  research,  involved  modifying  the  commutation 
waveform  lookup  tables  used  by  the  Moog  controller,  in  order  to  remove  sources  of 
torque  ripple.  Tliis  involved;  1 )  Adding  in  offsets  to  remove  phase  leakage  resulting 
from  nonzero  Sa  and  values  a.s  presented  in  Equation  4.7,  This  attenuated  the  A9 
frequency  ripple  found  in  the  Moog  motor.  Eventually,  this  aspect  of  the  compensation 
was  implemented  in  hardware.  2)  Adjusting  the  relative  magnitudes  of  the  commuta¬ 
tion  waveforms  in  order  to  account  for  the  Aa  value  used  in  Equations  4.9  and  4.10. 
3)  Finallyr  superimposing  higher  order  harmonics  on  the  fundamental  commutation 
waveform,  in  order  to  compensate  for  harmonic  induced  torque  ripple. 

As  noted  by  Le-Huy  et,  al.  (1986),  given  a  3-phase  wye  connected  brushless 
motor  vcith  no  neutral  connection,  current  harmonics  at  integer  multiples  of  three  of 
the  fmuiamental  frequency  cannot  l>e  pnnluceil.  Thtrefore,  harmonic  compensation  is 


SA 


accomplished  with  the  5th,  7th,  11th,  etc.  hamioiiics  of  the  fundamental  frequejicy. 
Le-huy  (1986)  and  his  colleagues  provided  a  solution  technicjue  for  choosing  the  opti¬ 
mal  magnitude  of  these  compensating  harmonics  based  on  the  back  EMF  frequency 
components.  One  of  their  concerns  was  to  limit  the  magnitude  of  any  o^e  harmonic  to 
10%  of  the  fundamental.  This  is  only  an  issue  with  motors  designed  with  a  trapezoidal 
flux  distribution.  The  Moog  motor,  was  designed  for  sinusoidal  flux  distribution  and 
therefore  the  spacial  harmonic  harmonics  are  too  small  to  require  magnitude  limits  on 
their  compensating  current  forms. 

The  approach  taken  to  harmonic  compensation  in  my  research  was  similar  in  prin¬ 
ciple  to  the  approach  taken  by  Le-Huy  et.  al.  The  odd  Imrmonics  were  identified 
throtigh  torque  measurements  and  their  magnitudes  were  normalized  in  terms  of  the 
fundamental  spacial  harmonic.  Current  waveforms  of  the  same  normalized  magnitude 
(in  relation  to  the  fundamental  current  waveform)  were  then  stiperimposed  on  the  com¬ 
mutation  waveform.  Current  harmonics  were  added  only  to  correspond  to  those  spacial 
harmonics  consitlererl  significant  in  terms  of  the  production  of  ripple  torque. 
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Chapter  5 
Results 

5.1  Torque  Sensor  Results 

The  cantilever  sen.sor  was  extremely  useful  in  my  research.  After  calibrating  the  seifsor 
with  weights,  the  amplilier  gain  was  adjusted  to  make  a  60  in.lb.  applied  torque 
appear  as  a  10  volt  torque  signal.  The  sensor  proved  to  be  both  stable  and  linear.  In 
addition,  the  rotating  collar  allowed  motor  torqxie  data  to  be  easily  recorded  at  various 
shaft  angles.  Most  of  the  torque  data  for  this  thesis  research  was  obtained  with  the 
cantilever  .sensor. 

Several  problems  were  encountered.  First,  the  basic  de.sign  of  the  sensor  did  not 
properly  address  the  issue  of  noise  isolation.  As  a  result,  in  order  to  generate  useful 
data,  it  W^s  necessary  to  pass  the  generated  torque  signal  through  a  3  stage  low  pass 
RC  filter  network.  Later,  a  6  pole  active  Butterworth  filter,  with  a  cut  off  frequency 
of  50  Hz  was  built  to  remove  noise  more  effectively.  In  addition,  it  became  clear  that 
shielding  the  signal,  voltage  supply  lines,  and  motor  power  cable  would  be  uecessarv 
to  optimize  joint  torque  sensor  performance.  Another  proldem  concerned  mechanical 
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bftcklnsh  iii  two  areas:  1)  The  shaft  keyway  allowed  a  slight  rotation  between  the 
rantllever  sensing  element  and  the  motor  shaft  and  2)  The  dowel  pins  on  the  rotating 
collar  did  not  fully  constrain  the  cantilever  tip.  The  backlash  produced  aberrant  results 
when  the  cantilever  sensor  was  used  to  identify  the  motor  harmonics.  Therefore,  this 
portion  of  the  research  was  performed  with  the  joint  torque  sensor. 

Other  aspects  of  the  cantilever  design,  while  not  creating  significant  problems, 
presented  opportunities  to  improve  the  joint  torque  sensor  design.  First,  it  was  clear 
that  full  Wheatstone  bridges  would  double  torque  sensitivity  and  eliminate  the  need 
to  provide  matched  resistors  for  the  third  and  fourth  bridge  leg.  Moreover,  the  <ise 
of  full  bridges  would  eliminate  some  lead  wire  and  reduce  the  associated  EMI  noise. 
In  addition,  by  choosing  temperature  coefficient  matched  strain  gauges,  the  effects  of 
thermal  drift  would  be  canceled  by  the  bridge  configuration  and  not  affect  the  sensor 
output. 

The  second  opportunity  for  improvement  lay  in  having  the  sensor  electronics  board 
fabricated.  In  the  cantilever  sensor,  the  electronics  were  wire  wrapped  and  probably 
held  up  much  longer  than  I  deserved.  I  decided  that  a  fabric  ated  board  would  be  much 
more  reliai^le  and  should  be  produced  for  the  joint  toT([ue  sensor. 

The  joint  torque  sensor  was  assembled  with  one  design  modification.  It  was  initially 
intended  that  the  slip  ring  would  be  attached  to  the  plastic  EMI  shield  bolted  on 
the  sensor  torque  shaft.  Unfortunately,  the  manufactured  shield  did  not  provide  the 
necessary  positional  accuracy  aiui  the  slip  ring  was  prone  to  excessive  runout  and  axi  i 
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nusHJigiiiufut  during  operation.  In  order  to  remedy  this,  the  EMI  shield  was  converted 
to  a  simple  tube  shape  and  a  precise  aluminum  disk  was  machined  to  attach  the  slip 
ring  to  the  sensing  element.  The  modification  reduced  runout  to  0.002  in.  and  virtually 
eliminated  shaft  misalignment. 

Upon  asseiiibly,  one  of  the  strain  gauge  bridges  proved  to  be  all  but  useless.  The 
500  ohm  bridge  exhibited  large  thermal  drift  and  was  therefore  disconnected.  The 
350  ohm  bridge  on  the  other  hand,  was  very  resistant  to  drift  problems.  This  is  probably 
a  result  of  the  efforts  at  Micro  Gage  to  match  the  thermal  coelhcients  of  each  sensor  in 
a  four  gauge  set. 

The  linearity  of  the  resulting  joint  torque  sensor  is  illustrated  in  the  calibration 
curve  of  Figure  5.1.  RMS  error  was  s:  0.034  volts  or  =5  3  oz.in.  Calibration  was 
accomplished  with  a  somewhat  crude  spring  force  gauge  and  pulley  system. 

The  signal  noise  level  in  tlie  joint  torque  sen.sor  signal  was  greatly  improved  when 
compared  to  the  cantilever  beam  sensor.  Unfiltered  RMS  noise  levels  w'ere  approx¬ 
imately  10  mV  for  the  joint  torque  sensor  as  compared  to  unfiltered  RMS  levels  of 
=:0.5  V  on  the  cantilever  sensor.  Such  low  noise  levels  allowed  the  joint  torque  sensor 
to  be  used- in  an  unfiltered  mode  although  oftentimes  data  was  recorded  with  the  But- 
terworth  filter  lowpassing  the  signal.  High  signal  quality  and  uiinimal  backlash  effects 
allowed  the  sensor  to  be  utilized  effectively  in  identifying  the  motor  spacial  harmonics. 
In  addition,  motor  torque  could  be  controlled  within  =rl*/i  by  digitally  closing  a  torque 
control  loop  around  the  motor  and  tortjue  censor. 
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Figure  5.1  Joint  torque  senior  calibration  curve. 

The  key  way  problem  was  greatly  improved  through  more  accurate  machining.  Un¬ 
fortunately,  unless  the  shaft  was  bonded  to  the  sensor,  keyway  backlash  effects  were 
still  noticeable.  Figures  5. 2-5. 6  show  sinusoidal  torque  controller  coimnands  at  1,  5.  10. 
25,  and  50  Hz  and  the  resulting  torque  sensor  output  with  the  output  pulley  locked  in 
one  position.  Two  characteristics  are  noticeable.  First,  the  slight  key  backlash  causes 
a  slight  distortion  ui  the  turnue  sensor  waveform.  Second,  a  higher  freciueiicv  vibration 
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Figure  5.2  Joint  torque  sensor  output  with  iHz  sinusoidal  input  command  providetl 
to  the  motor. 
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Figure  5.3  Joint  torque  sensor  output  with  5Hz  sinusoidal  input  command  provided 
to  the  motor. 

mode  appears  in  the  output  for  the  25  and  50  Hz  excitation  frequencies. 

Experiments  were  conducted  to  characterize  the  mode  appearing  in  the  excitation 
data  and  other  significant  dynamic  modes.  Initial  calculations  indicated  that  the  motor 
rotor/ torque  sensor  combination  would  exhibit  tw'o  zeros  (See  Appendix  III).  The  first 
zero  would  e.xist  at  ?:800  Hz  and  would  involve  the  motor  rotor  and  tnrqtte  shaft  inertia 


coupled  with  the  sensor  compliance.  The  second  zero  would  appe.ar  at  =;2400  Hz  and 


Figure  oA  Joint  torque  sensor  output  with  iOHz  sinusoidal  input  command  provided 
to  the  motor. 


Figure  5.5  Joint  torque  sensor  output  with  25H2  sinusoidal  input  command  provided 
to  the  niotor. 


involve  the  output  pulley  section  supported  by  the  sensor  compliance. 

The  P;;perimcnts  consisted  of  exciting  the  zeroes  in  a  pole  configuration  and  record¬ 
ing  the  torque  sensor  output  on  an  HP  Logic  Analyzer.  In  the  case  of  the  first  calculated 
zero,  the  pulley  was  locked  and  the  motor  was  given  a  step  input.  Figure  5.7  shov;s  the 
resulting  output  of  the  torque  sensor.  A  schematic  of  the  physical  situation  is  shown 
in  Figure  5.8.  The  data  inciicates  that  the  associated  sensor  rotor  zero  is  located  at 
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Figure  5.6  Joint  torque  sensor  output  with  .50Hz  sinusoidal  input  command  provided 
to  the  motor. 


^GOO  Hz.  Settling  time  is  approximately  4o  msec.  It  is  this  vibration  mode  which  is 
superiiiiposed  ou  the  frequency  responses  in  Figure  5.7  and  5.S. 
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Figure  5.7  Sensor  output  from  a  step  input  command  to  the  motor  with  the  sensor 
pulley  locked.  The  frequency  is  ^600  Hz. 

In  order  to  identify  the  second,  zero,  the  motor  shaft  was  locked  and  an  impulse  loading 
was  applied  to  the  sensor  pulley.  The  resulting  torque  sensor  output  is  presented  in 
Figure  .3.9.  The  phy.sical  situation  is  illustrated  in  Figure  5.10.  The  data  indicates  that 
the  a.ssociated  zero  is  located  at  ^2000  Hz.  The  settling  time  is  4  msec. 
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Torque  EMI  Shield 


FiE;vir(  :',8  Schematic  of  the  components  <oni rihiiting  to  the  tiOO  Hz  sensor  zero. 


Figure  5.9  Sensor  Output  for  an  impulse  loatling  of  the  sensor  pulley  with  the  motor 
shaft  locked.  The  frequence  is  -::  JOOO  Hz. 

These  modes  are  high  enough  in  frequency  so  that  incorporation  of  the  sensor 
into  the  lab's  cable  driven  inaniptilaNtr.  should  not  adversely  alfect  bandwidth.  It  is 
inter  stiiig  to  note  that  Figures  'j.7  aiui  'j.O  cieariy  show  tliat  rlie  joint  tm-qtie  sensor 
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Figure  5.10  Schematic  of  the  components  contributing  to  the  ^2600  Hz  sensor  zero. 

is  not  criticHlly  damped.  Atkesou  (1986)  recommended  that  critical  damping  should 
be  built  into  force  sensors  in  the  same  way  that  accelerometers  are  critically  damped. 
Atkesun  felt  that  such  damping  miglit  be  appropriate  in  applications  of  closed  luvtp 
force  contrttl.  Unfortunately,  initial  experiments  failed  to  provide  a  simple  method  of 
controlline  sensor  damping.  Instead,  the  settling  times  of  the  important  modes  are 
})resented  to  allow  for  proper  accomodation  in  controller  design. 


5.2  Current  Based  Torque  Control  Results 

Figure  5.1 1  presents  the  torque  output  of  the  Moog  motor  and  controller  as  a  function  of 
commanded  torque.  No  attempt  was  made  to  compensate  for  the  deadband  uonluiear- 
itv  located  around  zero.  It  was  felt  that  this  problem  would  be  best  addressed  through 
improved  controller  hardware  li.e.  current  sen.sors.  etc.)  or  torque  command  uioditica- 


tion.  It  is  ijirportaut  to  note  that  much  of  this  work  was  carried  out  in  anticipation  of 
receiving  new  and  improved  controller  hardware  from  Moog.  Tlie  new  hardware,  which 
w’ill  have  been  shipped  b}’  the  time  that  thir>  thesi.s  goes  to  print,  should  improve  sev¬ 
eral  aspects  of  system  performance  includiugr  current  loop  deadband,  overall  controller 
deadband  (shown  in  Figure  5.11).  and  system  stability.  The  work  in  this  thesis  has 
been  aimed  at  improving  motor /controller  performance  in  other  areas.  From  a  systems 
sta;.idpoint.  improvements  in  hardxvare.  .software,  and  our  overall  understanding  of  the 
system  will  eventually  be  combined  to  achieve  an  optimized  torque  control  system. 

The  first  attempt  at  current  base  torque  control  involved  producing  a  lookup  table 
of  the  effective  motor  torque  constant  as  a  ftmction  of  shaft  angle.  This  was  accom¬ 
plished  l)y  niecsuriug  output  torque  as  a  function  of  motor  angle  with  the  cantilever 
torque  sensor  This  data  was  then  used  to  create  a  fable  of  torque  correction  ratios 
which  could  be  used  to  modify  the  torque  commands  liefore  they  were  sent  to  the 
torque  controller.  This  approach,  implemented  with  a  V.ax  11  '750,  produced  limited 
improvcmcin in  torque  ripple  The  success  of  the  technique  was  liimted  by: 

1,1  noise  in  the  cantilever  sensor  torque  measurements,  and  2)  transient  variation  in  the 
phase  angle  of  various  torque  ripple  components. 

The  next  approach  involved  closing  a  torque  control  loop  and  recording  the  phase 
current r;  necessary  to  produce  linear  torque  output.  The  cantilever  sensor,  with  im¬ 
proved  cable  shielding  and  the  three  stage  low*  pass  filter,  was  used  to  measure  torque 
and  a  digital  control  loop  was  clo.sed  with  the  V’ax  11/750.  During  the  torque  control. 
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Figure  5.11  The  calibration  curve  for  the  Moog  controller, 


the  Vax  was  also  used  to  read  phase  current  command  levels  off  the  MDAC  chips  in 
the  torque  controller.  Multiple  readings  were  taken  at  each  motor  position  as  deter¬ 
mined  by  the  output  of  the  resolver  to  digital  converter  in  the  motor  controller.  The 
recorded  data  was  used  to  create  new  current  waveform  PROM  tables.  The  result .s 


were  luieresfiug. 
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Figufl^  5<12  Torqur  compensated  with  the  torque-loop-closure  phase  calibration 
method. 


Overall  torque  ripple  was  reduced  to  ^±2%  cf  output  torque.  Unfortunately,  the 
results  were  frau.sieut.  It  is  theorized  that  the  torque  performance  based  on  PROM 
rabies  correcred  iu  this  wav  is  particulariv  sensitive  to  changes  in  the  actual  mof<ir 


71 


torque  ripple.  This  is  because  the  unstable  and  stable  nonlinear  torque  characteristics 
are  both  an  integral  part  of  the  actual  correction.  Therefore,  while  this  technique 
offers  temporary  effectiveness,  significant  torque  ripple  returns  to  the  output  as  the 
underlying  motor/controller  characteristics  change.  Figure  o.l2  illustrates  the  initial 
torque  performance  improvement  restdting  from  this  technique. 

Finally,  feedforward  torque  compensation,  based  on  an  analysis  of  uncompensated 
(jutput  torque,  was  implemented  <in  the  Moog  equipment.  Figure  5.13  presents  the 
restdting  tortpie  otifput  as  a  function  of  shaft  angle.  The  total  torque  variation  is 
reduced  from  an  uncompensated  value  of  to  ^:;rl.59(  .  The  remaining  variafion 

is  attributed  to  deadltand  and  other  nonlinearities.  One  advantage  is  that  this  technique 
is  much  less  sensitive  to  transient  effects  in  the  controller  and  the  resultant  degradation 
of  performance  over  time.  In  addition,  the  technique  promises  to  produce  excellent 
l)erformance  when  it  is  implemented  on  the  improved  controller  hardware.  The  results 
of  each  aspect  of  the  feedforward  compensation  technique  is  presented  in  the  following 
paragrap);  . 

The  most  significant  torque  ripple  component  in  the  Moog  motor  existed  at  twice 
the  fundalnental  frequency  and  possessed  a  magnitude  proportional  to  the  torque  com¬ 
mand.  It  was  theorized  that  this  output  ripple  could  be  attributed  to  magnitude 
offsets  in  the  fundamental  phase  current  waveforms.  As  stated  in  Chapter  5.  by  care- 
fullv  superimposing  sinewaves  on  the  fundamental  wavetV)nns.  one  ran  generate 


‘2n(i  compensating  tortiue  ripples  of  a  desired  phase  and  magnitude.  Such  an  approacli 
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Figure  5.13  Torque  compensAted  with  commutAtion  waveform  modification  based 
on  output  torque  analysis. 


was  utilized  with  good  results. 

In  order  to  conipeusafe  for  aii  =5:  rS'/J  ripple,  a  12%  waveform  was  added  to 
phase  X,  etfectiveiv  iucreasiug  the  phase  A  current  luaKuitude.  In  order  to  oompeu.sate 
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for  an  SB  ripple  at  3U“,  it  was  necessary  to  draw  this  additional  current  through  phase 
C.  In  light  of  this,  the  phase  B  waveform  was  not  altered.  The  techniqtie  resulted 
ill  a  reduction  of  the  8^  ripple  to  5^1%  of  output  torcpie.  Unfortunately,  the  remain¬ 
ing  SB  ripple  component  was  not  readily  characterizable  and  therefore  could  not  be 
compensated. 

Torque  ripple  resulting  from  offsets  in  the  fundamental  current  waveforms  pro¬ 
duced  a  constant  n^  ripple  of  approximately  ±3%  of  continuous  output  torque.  Ini¬ 
tially.  the  4B  ripple  was  removed  ft>r  given  torque  output  levels  by  modifying  the  phase 
current  lookup  tables.  This  method  was  useful  for  analyzing  the  torque  ripple  antt’  its 
currectability.  Unfortunately,  correction  implemented  in  this  way  is  proportional  to 
output  torque.  Therefore,  final  compensation  was  achieved  by  adjusting  zeroing  pots 
in  the  phase  current  loop  reference  circuitry.  This  is  clearly  where  the  problem  arises 
and  therefore  where  it  should  be  corrected  fnun  a  systems  standpoint.  The  end  result 
was  a  ripple  of  approximately  0.5%  of  continuous  output  torque. 

Turqiie  ripple  arising  from  motor  spacial  harmo'i’^  .vas  minimized  by  entering 
corresponding  current  harmonics  in  the  phase  waveform  tables.  In  order  to  accomplish 
this,  the  Spacial  harmonics  were  first  identified.  Figure  5.14  shows  the  results  of  torque 
measurements  resulting  when  static  current  vectors  were  fed  into  the  motor  phases. 
Accuracy  was  increased  by  disconnecting  the  unused  phase  in  each  of  the  three  exper¬ 
iments.  In  the  first,  a  constant  current  was  driven  into  phase  C  and  out  phase  .A..  In 
the  second,  a  constant  current  was  driven  into  phase  B  and  out  phase  C.  The  final 


Figure  5.14  Harmonic  identification  output  torques.  The  three  curves  are:  dashed  - 
phase  A  and  C  carrying  current,  dotted  -  phase  B  and  (’  carrying  current,  and  solid 
-  phase  A  and  B  carrying  current. 

experiment  involved  driving  a  constant  current  into  phase  A  and  out  phase  B. 


By  performing  an  FFT  on  the  data  from  each  experiment,  the  significant  spacial 
harmonics  were  identified  and  are  shown  in  Figure  5.16.  The  magnitttdes  of  the  5th  and 
7th  harmonics  are  exagerated  relative  to  the  primarv  frequencv  for  claritv.  The  actual 
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uiagnitudes,  normalized  in  relation  to  the  fundamental  spacial  harmonic  magnitude, 
were  determined  to  he  0.008  for  the  6th  harmonic  and  -0.0017  for  the  7th  harmonic. 


Figure  5.15  A  componentwise  decomposition  of  the  motor  spacial  harmonics.  The 
magnitudes  of  the  5th  and  7th  harmonics  of  the  fundamental  are  exaggerated  for 
clarity. 

Compensation  was  accomplished  by  superimposing  oiiO  and  7n^  sinusoids  on  the  fun¬ 
damental  phase  waveforms  in  the  PROMs.  Torque  ripple  at  Gnt)>  was  reduced  fivefold 
from  ::  to  r  of  output  tortiue.  Fitjure  .5. 1C  illustrates  the  tortiue  ripple 
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attributable  to  uinnocleled  motor  spacial  harmoiiirs.  Figure  5.17  presents  the  results  of 
utilizing  the  higher  order  current  harmonics  to  reduce  this  ripple.  The  other  significant 
ripples  have  been  removed  to  reveal  the  involved  freipiencies  more  clearly. 

The  implementation  of  ciirrent  based  torcjue  control  has  demonstrated  that  it  can 
be  significantly  improved  through  feedforward  compensation  and  fundamental  wave¬ 
form  modification.  Overall,  it  appears  that  brushless  motor  output  torque  can  be 
controlled  with  a  reasonable  degree  of  accuracy  through  phase  current  control.  Torque 
ripple  as  a  tunction  of  angle  can  be  reduced  to  r:5=1.5‘'7.  In  addition,  the  torque  out¬ 
put  can  be  reasonably  calibrated  with  respect  to  input  command,  a  situation  that  will 
improve  with  the  new  controller  hardware. 


Motor  Torque  (ozin) 


Figure  5.16  The  Moog  motor  6nd  torque  ripple  component. 
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Chapter  6 
Conclusion 

Torque  densors  were  developed  for  torque  measurement  and  feedback  control  of  a  Moog 
303-003  brushless  motor.  The  cantilever  sensor  provided  a  good  instrument  for  record¬ 
ing  torque  output  data.  The  joint  torque  sensor  exhibits  good  linearity,  repeatability, 
noise  rejection,  and  dynamic  characteristics.  In  addition,  it  is  ctunpatible  with  the 
current  cable  driven  manipulator  design  being  developed  in  the  lab. 

The  torque  characteristics  of  a  Moog  303-003  brushless  motor  were  studied.  Out¬ 
put  torque  nonlinearities  were  identified  and  their  origins  were  determined.  Techniques 
were  developed  to  compensate  for  torque  nonlinearities  through  feeilforvvard  phase  cur¬ 
rent  compensation.  It  was  found  that  the  most  significant  sources  of  torque  variation 
were:  phase  current  offsets,  phase  current  magnitude  variations,  current  loop  deadband, 
and  unmodeled  spacial  harmonics.  We  feel  that  the  best  way  to  reduce  the  effect  of 
these  errors  is  to  improve  controller  hardware  and  utilize  phase  waveform  compensation 
techniques  such  as  phase  magnitude  and  spacial  harmonic  feedforward  compensation. 

Overall,  it  is  apparent  that  the  need  for  torque  sensor  feedback  can  no  longer 
be  assumed  in  the  torque  control  of  brushless  motors.  Current  based  torque  control 
fcchniipies  can  provide  verv  reasonable  accuracv  levels  with  less  complexitv  and  hicher 
bamlwiiitli  than  is  possible  with  fitrtiue  sensors.  Therefore,  one  must  take  i  !oi»k  at  the 
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entire  torque  control  system  anil  decide  what  is  the  best  torque  control  technique  for 
a  given  application. 


Brushless  Resolver 


Performance  Spec 

\'’alue 

Input  Voltage 

1 

6.0  VAC 

1 

Iiiptit  Freqtieucy 

1 

1 

1000  Hz 

i 

Input  Current  Max  i 

15.0  niA 

i 

Transformation  Ratio  j 

.45:1 

Output  \’oltage  1 

2.72  VAC 

Moog  Torq  Controller  152-003 


Pevfoniiauce  Spec 

1 

\’alue 

Continuous  Current 

1 

15  Amps 

Peak  Current 

j 

30  Amp.s 

j 

Switching  Frecjueucy  j 

5KHz 

Efficiency 

95% 

Driver  Voltage 


325  Volt 


Housing  Width 


Overall  Length:  3.66  in. 
Housing  Width:  2.7S  in. 
Output  Shaft:  0.375  in.  dia. 


Figure  A.I.l.  Moog  303-003  Brushiests  Motor  and  Resolver. 


Muior  Speed  (KHFWl 
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1  10  15  00 

Output  Torque  (in. lb.) 


Figure  A. 1. 2.  Moog  303-003  Performance  Curve. 


Appendix  II 
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The  Design  of  a  Cantilever  Torque  Sensor 


The  cantilever  beam  shown  in  Figiire  A. 2.1  has  the  following  characteristics: 


h  =  0.340in. 


h  =  0.240in. 


</l  -  O.TOOin. 


<i2  =  l.TOOin. 


E  =  lOe^si 

The  strain  at  the  gauges  under  maximum  torque  loading  is  calculated  using  standard 
equations: 

I  =  =  ^(.34iu.)(.24in)^ 

((/2-dl)  (1.7in.  -  O.Tin.) 

M  r - — -  =  (GOin.lb.  - - =  Zo.29-iin.lb. 

(12  1.7m. 

where  Dl,  D2,  b,  and  h  are  shown  in  Figure  A. 2.1.  The  stress  is  computed  from: 

^  Me  6M  6(35.3iu.lb.) 

=  T  =  ^  =  (.34i«.)(.24in.)^  = 

Which  allows  the  gauge  strain  to  be  calculated: 

_  Stress  10,813psi  .  .. 

Strain  =  — = —  =  - - — r-  =:  llOO^un/m 

£  10t«psi 


The  gautte  eiectromes  are  shown  in  figure  .4.2.2.  The  following  characteristics  are 


SO 


Figure  A.2.1  The  aluminum  cantilever  beam  and  relative  positioning  of  the  stinlt. 
gauges  and  dowel  pin  stops. 


noted: 


G  =  Gauge.  Factor  = 


Gauge  Resistance  =  350il 

Change  in  Resistance 


Strain 
Et,  =  Svolts 


=  135fi 


The  necessary  gain  is  calculated  as  follows: 


Eo  =  Ei{ 


AiZ  =  GiZ(Strain) 
Ri  _ 


)  =  0.359volts 


iRi  +  R<)  + 

lOvolts 

Amplifier  Gam  =  -  -8 


1 


8 


Torque 

Signal 


Wheatstone  Half  Bridge 


Figure  A.2.2  An  electrical  schematic  for  the  cantilevered  sensor  electronics. 


Appendix  III 
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The  Design  Equations  for  the  Joint  Torque  Sensor 

The  gauging  surface  was  designed  to  withstand  reasonable  loadings  and  provide  lUOO// 
sn./in.  strain  at  the  strain  gauge  orientation  under  peak  torque  loading  cuiulirioiis. 
The  strain  gauges  were  oriented  at  45®  and  135®  to  the  shaft  axis  in  order  to  nicasuK' 
maximum  normal  strain  arising  from  torsional  loading.  The  following  equation  gives 
the  45°  strain  under  torsional  loading  for  a  thin  walled  tube: 


Sif^CLZTlA^Q  « 


{Torque)Rg 


The  I.D.  for  the  gauging  surface  was  chosen  to  be  0.5432  in.  This  diameter  coiifspoud 
to  a  17/32  in.  standard  reamer  and  was  chosen,  for  manufacturability. 


Strain  450  = 


(60in./&.)(0.2716in.) 
7r(11.5e«P'SO(0.2716^  -  0.2656") 


Sirain^io  =  dlOfxin./ in. 


The  stiffness  of  the  sensor  is  calculated  based  on  the  following  equation; 


Stiffness  = 


Torsional  Moment 


Stiffness  = 


Angular  Deflection 
itG{Ro*  -  Ri*)  vr(11.5e«psi)(.2716‘‘  -  .2656^ ) 


21 


Stiffness  =  24, 830 


Ib.in. 

rad 


2(.3383) 


ss  ^60{CableStif fness) 


8U 


Torsional  Buckling  Stress 


Check  for  buckling  (Roark  and  Young  (1983))  due  to  toision: 

r  _  0.2716  _ 

7“  0.006 

Since  this  is  greater  than  10,  the  following  equations  apply  and  tin.-  iu-tu;il  >li('iii  >r 
and  approximate  buckling  torsional  stress  can  be  calculated. 


Shear  Stress  — 


T  __  dOin.lb. 

2iTrH  ~  2rr(0.2716)-'(0.006; 


Buckling  Stress  ss  IS^osi 

0  60.£1  t^  — _ 

Buckling  Stress  =  ^'^2]  (“2.39  -f  \/96.9  -f  0.605/f^5) 


where  /i  =  0.2S  and: 


..  ./; - 0-3383» 

^  ®  (0.006(0.2716)2)  ~  ° 

Buckling  Stress  as  112^'s^ 


Check  the  factor  of  safety: 


Factor  of  Safety  = 


Buckling  Stress  \l'2ksi 


Shear  Stress 


\Sk  St 


Axial  Buckling  Stress 


Check  for  buckling  (roark  and  Young  (1983))  due  to  axial  loading: 

„  ^  0.40  E  t  0.40  SOe**  0.000 

Buckling  Stress  as  =r— 7a=z=-  =  sr  ';s.isi~^.~7rrz  •  "J 

V3  v'l  “  ^/l  -  .2S-«  0.2/5 

Buckling  Stress  as  IQOksi 
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The  maximum  end  loading  can  now  be  calculated; 

Section  Area  ss  0.006m(27r)0.275in  %  O.Olin^ 
Maximum  Thrust  Load  =  Buckling  Stress{Area)  s;  iGOOlh. 


Strain  Gauge  Calculations 


The  surface  strain  at  the  orientation  of  the  strain  gauges  is  calculated  for  the  g;uig(’ 
section; 


Strain4so 


Mra  60in/6(0.5432/2) 

irG(ro*  -  r,-*)  "  7r(11.5e'5)((0.5432/2)4  -  (0.5312/2)^) 


Strain^io  ^  lOOO^m/zn 


Amplifier  Gain 


Calculate  the  change  in  resistance  for  peak  strain; 

AR  =  GRiS train ) 


Given  that  G  —  Gauge  Factor  =  120,  AR  —  3417,  for  a  full  Wheatstiuie  Dridge: 


E,  =  E^{ 


Ri 


Ri  +  R4  R2  +  R3 


)  =  5.0V^( 


316 


384  +  316  316  +  384 


)  =  o.osr 


This  value  is  SB9.6mV/inlbf.  The  actual  value  was  8.9  mV/in. Ibf.  and  thercfoic  rlu' 
gain  was  set  to  22.  This  was  done  in  order  to  produce  a  full  scale  .signal  of  +/- 12\'  .0 


peak  torque. 


Figure  A.3.1  An  electrical  schematic  for  the  joint  torque  sensor  electronics. 


Vibrational  Modes 


Calculate  t&e  zeroes  of  the  torque  sensor: 


Stiffness  =  2<i,830lb/rad 


Roughly  calculate  the  pulley  section  inertia: 

dtunr*  {  0."ub/in^  )i  l.otr?  .K  ?r  i(  0.6/7?  i  ‘ 


I  = 


\2)[32.2lbf  / Ibm /f.sec*  ;(  Vlin/lb) 


yi 


Signal  #2 


2 


u;„  «  840Hz 
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